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Listing of Claims: 

This listing of claims will replace all prior versions and listings of claims in 
the application: 

1. (Currently Amended) A system for estimating the position, velocity and 
orientation of a vehicle, comprising: 

m e ans for d e t e rmin i ng th e compon e nts of two nonco lli n e ar constant unit 
v o ctors g b ,c b accord i ng to vehic le body ax o s, said m e ans inc l uding: 

- an Inertial Measurement Unit (IMU) including a group of at least 
three gyroscopes for measuring the angular velocity 3 b (t) of the vehicle in 
body axes and at least three accelerometers located along the vehicle 
body axes to provide the specific force a b in body axes; 

- a magnetometer able to measure the Earth's magnetic field 
according to the vehicle body axes; 

- static pressure and differential pressure sensors; 

- two vanes to measure the angles of attack and side slip; 

- an angular velocity acquisition and processing module configured 
to acquire the angular velocity 3 b (t) and delay it to obtain & b {t-r) ; 

- a data acquisition and processing module configured to acquire 
the specific force a b {t) measured by the accelerometers, the static 
pressure p s (t) measured in sensor, the differential pressure p d (t) 
measured in sensor, the angle of attack a(t) measured in sensor, the 
angle of sideslip J3(t) measured in sensor and the value of the Earth's 
magnetic field m b (t) measured in the magnetometer, delay them and 
process them to calculate the true airspeed 0{t-r), the air velocity in 
body axes v b (t-r) as follows: 
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0 cos a cos (3 
v b - usin/7 
£?sin<2cos/? 

the numerical derivative of the air velocity in body axes v b (t-r), 
the local gravity in body axes g b as follows: 

g„(t-T) = <> b (t-T) + 3 b (t-T)xV b (t-T)-a b (t-T) 

and the projection of the Earth's magnetic field on the horizontal plane 
perpendicular to local gravity e(t-r) as follows: 

e b (t - r) = fh b (t - r) - m b (t - r) ■ ^ " ; 

a GPS receiver for determining the components of said-two noncollinear 
constant unit vectors according to the Earth's axes; wherein the data 
provided by the GPS are acquired, processed and used in the data acquisition 
and processing module to calculate said components g„e t ; 

whor o in th e system comprises 

a module for correcting said angular velocity 5> b with a correction u m and 
obtaining a corrected angular velocity & b = 6> b + u a ; 

a module for integrating the kinematic equations of the vehicle receiving 
the corrected angular velocity $> b as input and providing the transformation matrix 
ifor transforming Earth's axes into vehicle body axes and the orientation of the 
vehicle in the form of Euler angles 6 ; 

a synthesis module of the components in body axes of the two 
noncollinear constant unit vectors to provide an estimation of said noncollinear 
vectors in body axes g b ,e b , where said estimation is calculated as follows: 

g b =Bg, 
e„=Be t 

a control module implementing a control law to calculate said correction 
u m , where said control law is: 
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u a =tr(g b xg b +e b xe b ) [1] 
where a is a positive scalar, 

such that by applying this correction u a to the measured angular velocity 
3 b and using the resulting angular velocity d> b = a b +u 0) as input to the module 
for integrating the kinematic equations, the latter are stable in the ISS sense and 
the error in the estimation of the direction cosine matrix B and of the Euler 
angles 6 is bounded. 

2. (Previously Presented) The system according to claim 1, wherein said 
noncollinear unit vectors g,e are local gravity g and projection of the magnetic 
field on the plane perpendicular to gravity e . 

3-4. (Canceled) 

5. (Currently Amended) The system according to claim 1 , further comprising 
wh o r oi n the oyotom inc l udes a Savitzky-Golay filter where v b , numerical 
derivative of v b , is calculated. 

6. (Currently Amended) The system according to claim 1 . further comprising 
includincj' 

a navigation module where the navigation equations of the vehicle are 
integrated from the specific force a b and the direction cosine matrix B to obtain 
calculated position and velocity in local axes and corrected in a Kalman filter to 
obtain estimated position and velocity in local axes. 

7. (Previously Presented) A method for estimating the position, velocity and 
orientation of a vehicle comprising: 

calculating the components of two noncollinear constant unit vectors g b ,e b 
according to vehicle body axes from measurements of sensors located in the 
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vehicle according to the body axes of the latter, said calculation comprising: 



- measuring specific force a b {t) in body axes, static pressure p s (t) , 
differential pressure p d (t) , angle of attack 5(0, angle of sideslip pit) and 
the value of the Earth's magnetic field m h (t) ; 

- calculating the true airspeed 6{t) from the differential pressure 
p d (t) and static pressure p s (t) measurements and from knowing the 
outside temperature at the initial moment T 0 ; 

- calculating the air velocity in body axes as follows: 

6 cos a cos/ 

v sin ft 
v since cos / 

- delaying a time v the angular velocity & b {t) , specific force a b {t) , 
magnetic field m b (t) and air velocity in body axes v b (t) ; 

- calculating the numerical derivative of the air velocity in body axes 

- calculating the local gravity in body axes g b as follows: 

g b (t-T) = i> b (t-T) + d b (t-T)xv b (t-T)-a b (t-T)]y, 

- calculating the projection of the Earth's magnetic field on the 
horizontal plane perpendicular to local gravity as follows: 

e b {t -r) = m b (t-r)- fh b {t - r) ■ ~ ^ ; 

calculating the components of said noncollinear constant unit vectors 
g t ,e t , according to the Earth's axes from measurements of sensors located in the 
vehicle which provide position in Earth-fixed axes; 

measuring the three components of angular velocity m b of the vehicle in 
body axes; 

correcting the angular velocity 5> b with a correction u a and obtaining a 
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corrected angular velocity S b =a b +u a ; 

integrating the kinematic equations of the vehicle, according to the 
corrected angular velocity m b and providing the transformation matrix B for 
transforming the Earth's axes into vehicle body axes and the orientation of the 
vehicle in the form of Euler angles 6 ; 

calculating an estimation of the components in body axes of the two 
noncollinear constant unit vectors g b ,e b , where said estimation is calculated as 
follows: 

g b =Bg t 
e b = Be, 

obtaining the correction u a by means of the control law: 

K =cr(g b xg b + e b xe b ) [1] 
where a is a positive scalar, 

such that upon applying this correction u a to the measured angular 
velocity 3 b and using the resulting angular velocity S b = a b +u a as input to the 
module for integrating the kinematic equations, the latter are stable in the ISS 
sense and the error in the estimation of the direction cosine matrix B and of the 
Euler angles 6 is bounded. 

8. (Previously Presented) The method according to claim 7, wherein said 
noncollinear unit vectors g,e are local gravity g and projection of the magnetic 
field on the plane perpendicular to gravity e . 

9-10. (Canceled). 

1 1 . (Previously Presented) The method according to claim 7 Q, wherein v b , the 
numerical derivative of v b , is calculated in a Savitzky-Golay filter. 
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12. (Previously Presented) A method according to claim 7 including: 

integrating the navigation equations of the vehicle according to the specific 
force a b and the direction cosine matrix B to obtain the calculated position 
and velocity in local axes and they are corrected in a Kalman filter to 
obtain estimated position and velocity in local axes. 
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